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1. INTRODUCTION 

It has been widely recognized that modelling errors can lead 
to sensitivity problems and even divergence of Kalman-Bucy filter. 

In cases where the nominal plant parameters used in the filter design 
are different from the actual plant parameters, the uncompensated 
mismatched steady state Kalman-Bucy filter exhibits bias errors, Athans [1] 
discussed this problem, and presented a brief survey of the various 
schemes to reduce filter sensitivity. In particular Ref. [1] 
introduced the continuous time compensated Kalman filter, a sub- 
optimal state estimator which can be used to eliminate steady state 
bias errors when it is used in conjunction with the mismatched 
steady state (asymptotic) time-invariant Kalman-Bucy filter. The ap¬ 
proach used relies on the utilization of the residual (innovations) 
process of the mismatched filter to estimate, via a Kalman-Bucy 
filter, the state estimation errors and subsequent improvements of 
the state estimate. The compensated Kalman filter augments the mis¬ 
matched steady state Kalman-Bucy filter by the introduction of ad¬ 
ditional dynamics and feedforward integral compensation channels 0 
Satisfactory results of this compensated Kalman filter in a practical 
design have been reported by Michael and Farrar [2], where it was 
applied to the estimation and control of critical gas turbine engine 
variables. 

This note follows the same philosophy and development as [1] , 
for the discrete time case. In section 2 r we give definitions and 
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and assumptions as well as the definition of the nominal mismatched steady 
state Kalman-Bucy filter. Section 3 analyzes the errors due to mismatching. 
Section 4 contains the main contribution which deals with the development 
of the compensated filter structure and equations. Section 5 contains the 
discussion of the results. 

The elimination of bias errors is accomplished by having accumulators 
(the analog of integrators) acting upon the residuals. Thus if persistent 
bias errors exist due to model mismatching, the accumulators provide the 
necessary corrections so that the bias errors are removed from the estimates 
in steady state. 

The approach selected was dictated by issues of simplicity of design, 
namely the use of constant gains in the estimator realization, and the avoid¬ 
ance of real time parameter estimation, which requires extensive real time 
calculations. All calculations of the constant filter gains can be carried 
out off-line. 
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2. DEFINITIONS AND ASSUMPTIONS 

Only modelling errors in plant parameters will be considered 
throughout this paper- We believe that this is often the case in 
practice. When there are errors in the statistical parameters of the 
underlying random processes, a different approach is required and the 
results are more complicated. 

2.1 Actual Plant Description 

We assume that the actual plant is an n-th order linear time- 
invariant f stochastic dynamical system with state vector x(t)£ R n , 

Ttl J 

constant input vector u_ £ and noisy measurement vector z(t)£ R 
described by 


(State Equation) x(t+l) « A 3c(t) + u + <^(t) (1) 

(Measurement Equation) jz(t) = C_ ^c(t) + (Ht) (2) 

where A, B., are respectively nxn, nxm r rxn constant matrices-.. 

The plant noise j^(t) and the measurement noise S^t) are white 
Gaussian stationary processes with the following statistics, which 
are assumed to be known to the designer. 


E(£(t))= 0 
e{£( S )£' (t)}= 56 st 

E (9_( t)) = 0 

E{0(s)e i (t) } - 06 

— — — st 


for all t 
for all s,t 
for all t 


(3) 

(4) 

( 5 ) 
(S) 


for all s,t 
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where 6 denotes the Kronecker delta, and E, the plant noise 
st — 

intensity matrix, is a constant nxn positive semi-definite symmetric 
matrix, while 0, the measurement noise intensity matrix is a 
constant rxr positive definite symmetric matrix. Moreover, C/t) 
and 9(s) are assumed to be uncorrelated for all s, t, i.e. 

E{£(t)e/ (s)> - 0 (7) 

It is further assumed that (with t^ - 00 ) 

E{x(t Q )} =0 (8) 

2.2 Model Description 

The actual plant dynamics are defined by the values of the 
three constant matrices A, B., £ in equations (1) and (2), and 

the noise statistics defined in equations (3)-(8). We shall assume 

that the actual values of A, B_ and C are not known exactly to the 

designer. Rather, nominal values A , B , C are available to the 

-“n —n —n 

designer in addition to perfect knowledge of the noise statistics, and 
the value of the constant input vector u. Thus as far as the designer 
is concerned, the model is given by 

x(t+l) = A x(t) + B u + £(t) (9) 

— —n — —n — — 

z(t) = C x(t) + 0(t) 


( 10 ) 
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For later development, define 
matrices: 


aa 

A 




A - 

A 

■ 


*— 

—n 

AB 

A 



= 

B - 

B 



*—* 

—n 

AC 

A 




C - 

C 

—n 


the following parameter error 

( 11 ) 

( 12 ) 

(13) 


2.3 Further Assumptions 

We limit the discussions to constant gain filters, as in [1], 
since they represent one of the most practical uses of Kalman- 
Bucy filters from the application viewpoint, and they can readily 
lead into steady state error and stability analysis* The following 
assumptions are necessary for the derivation of the results. 

1. [A,B] and [A ,B ] are controllable pairs. 

■“ — —n ti 

2. [A,C] and [A ,C ] are observable pairs. 

— — —n —n 

- 1/2 - 1/2 

3. [A f c ] and [A ] are controllable pairs. 

_ — —n — 

4. Both A and A are strictly stable matrices, i*.e 

— n 

all of their eigenvalues lie within the unit 

circle. This also implies that (A-I) ^ and (A - I) ^ exist. 

— — —n 

These assumptions are indeed necessary for the rigorous development 
of a unique, stable, steady state Kalman-Bucy filter. 
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2.4 Definition of the Nominal Mismatched Steady-State Kalman 





Nominal 



i 
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Figure Is Discrete Time Nominal Mismatched Steady State Kalman^Bucy Filter 
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3. ERRORS DUE TO MISMATCHING 

If the NMSSKBF of Figure 1 is used without further compensation , 

severe inaccuracies arise due to the fact that the nominal plant 

matrices A , B , C are used rather than the actual (but unknown) 

—n —n —n 

matrices A, B^, C* These effects are particularly bothersome because 
bias errors in the estimates exist. It is instructive to isolate 
these errors, because the structure of the equation suggests that 
compensation techniques can be used* 


3.1 Estimation Errors and their Dynamics 

Define the state estimation error x (t) induced by the 

— 1 n 

NMSSKBF by 


x (t) = x(t) - x (t t-1) 

—n — -n 


(19) 


From equations (1), (2), (14) r (15), and (19), one can readily 


deduce that the state estimate error x (t) satisfies the stochastic 

—n 

difference equation 


x (t+1) = A x(t) + B u + £(t) - (A x (t) + B u) (20) 
—n — — — — — —n—n ~n— 


Rearranging, one obtains 
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X (t+l) 
—n 


[A -A G C ]x (t) + £(t)-A G 0(t) + AA X (t) -A G AC x(t) 

—n —n—n-n —n — —n —n— — — - n—n —• — 

+ AB u (21) 


3.2 Wean State Estimation Error 

Equation £21) readily allows one to deduce the effects of model 
mismatching upon the estimation errors; bias effects are introduced. 
To compute these, one simply takes expected values in equation (21) • 
We remark that the expectations are not conditional ones, since the 
filter structure has been fixed. Thus 

E{S (t+l)} = [A - A G C ]E{x (t)} + Aa e{ x (t) } 

—n -n —n—n-n —n — '— 

r , ( 22 ) 

-A G AC E{x(t) } + AEu 
—n—n — — - 

But from equation (1) r 

E{x (t+l)} = A E{x(t)} + B U (23) 

—n — — — — 

This yields, in view of equation (_8), a non-zero mean state r i„e,, 

t 

E{x(t) } = S u ? £ (24) 

a 

Thus, if some or all of AA, AB , and Ac are non-zero, then one can 
readily conclude from (22) that bias errors exist. Note that the 
effect of the constant input u accentuates these errors, even for 
stable system. From equations C22) and C24), 
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t-t. 


E{x (t)} 

—n 


[A -A G C ] 
—n “n-n-n 


E{x (t )} 
—n 0 


(25) 


+ 



s 


[A-A G C ] 
—n —n —n—n 



Noting that, in view of equations (8) and (14), 


E{x (t ) } = E{x(t n )} - E{x (t )} = 0 
—n 0 — 0 — —n 0 — 


(26) 


equation (25) becomes 


E{5 (t) } 


Y' [A -A G C ] t ** S { [ AA - A G Ac] [ 23 A S “ T B]+AB>u 
“ —n —n-n-n — -n—n T _. — — — 

3 " r 0 “0 (27) 


This is in general non-vanishing f and cannot be evaluated since A, B, C, 
AA, AB, Ac are not known exactly. In particular, as t gets large, the 
mean steady state estimation errors are approached, 

lim E{x(t) } = — [A—I] ^ B^ ]u (28) 

tr*® 

lim E{x (t) } = [A -AG C - I] -1 { [AA-A G AC] [A-I] _1 B-Ab}u (29) 

—n “n—n—n —-rr-n—-- 

tr * 30 

Both of these are non-zero. Therefore, in the mismatched case, there 
exists a non-zero mean steady-state estimation error. Again, due to 
incomplete information, one cannot compute this mean steady-state 

A 

estimate error so as to add it to the NMSSKBF estimate x (t) to arrive 

—n 
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at unbiased estimates. 

3.3 Discussion 

The above development indicates that the NMSSKBF should not be 
used without further modification. It necessitates the lose of com¬ 
pensation by a suboptimal estimator, because the truly optimal filter 
(that estimates the unknown elements of A, 13 and C) is an infinite 
dimensional one [3J . The degree of suboptimality has to be related 
to the extra dynamics that are required to improve the performance 
of the nominal mismatched Kalman-Bucy filter. 

The next section presents a compensation technique, which is 
similar to [1] • The central idea is that it augments the NMSSKBF 
by additional filter dynamics and tries to extract further informa¬ 
tion from the residual (innovation) processes. It has the merits 
that all gains can be pre-computed, and it avoids the complexity of 
non-linear estimation (or the extended Kalman filter algorithm) which 
is not always guaranteed to work properly [3]. Moreover, it compen¬ 
sates the biased mean steady state estimate error without sacrificing 
the accuracy of the state estimate, i.e. increase of RMS errors, which is 
very often the case when other techniques are used, e.g. f increased 
artifical plant noise covariance matrix I4J. 
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4. TW. DEVELOPMENT OF THE DYNAMIC FILTER COMPENSATOR 

First recall the dynamic equations of the state 

estimation error x (t), and the residual process r (t) (equations 

—n —n 

(21), (15)). 


x (t+1) = 


[A -A G C ]x (t) + C(t) —A G 0 (t) + AA x(t)—A G AC x(t) 
—n n— n —n —n —--—' ”“ — 


+ AB u 


(30) 


r (t) = z(t) - C x Ct t-1) 
—n — —n —n 


(31) 


Using equations (1),(2) and (19), equation (31) can be written as 


r (t) = C x (t) + AC x(t) + 0 (t) (32) 

—n —n —n — — 

Note that the residual process r (t) is linear in the state estimation 

—n 

error x (t) . It is reasonable to attempt using equation (32) as a 

—n 

"measurement equation" to obtain an estimate of x^(t), the state 
estimation error. However, the existence of the unknown matrices, Aa , 

AB and AC in equations (30) and (32) prohibits us from solving this as 
a linear estimation problem. Thus certain approximations have to be made. 
In what follows, it is shown how one can form such a linear estima¬ 
tion problem, by making approximations with, reasonable physical inter¬ 
pretation. 
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4.1 Philosophy 

n it 

Define the time sequences w(t)e R and v(t )E R as 

follows: 


w(t) = AA x(t) + AB u 
v(t) = AC x(t) 


(33) 

(34) 


Thus equations (30) and (32 > reduce to 


X (t+1) » [A-A G C ]X (t) + w(t)-A G v(t) + £ (t)-A G 0 (t) 
—^ —n —n rr-n —n — —~ —"— — —- —^— 


(35) 


r (t) - C x (t) + v(t) + 0(t) 
—n —n —n — — 


(36) 


Now it is apparent that equations (35) and (36) form a linear esti¬ 
mation problem, with correlated plant and measurement noise , provided 
that w(t) and v(t) satisfy linear equations. So the next step is to 
develop simple linear equations for w(t) and v(t) • If one is pri¬ 
marily interested in the development of a steady-state constant gain 
filter, one can proceed as follows.. 

From equations (28) and (33), we can deduce that 

lim E{w(t) } = [ AB + AA(I-A) 23]u^ = unknown constant (37) 

tr * 30 

Also 

w(t-KL) - w(t) = AA [ (A-I) x (t) + B u] + AAg( t) 


(38) 
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Equation (37) implies that w(t) must have a nonzero (but unknown) 
mean steady state, while equation (38) indicates that it must contain 
a zero mean driving noise temu Both of these objectives can be 
satisfied if one selects the dynamics of w(.t) to be of the form 

w(t+l) - w(t) = ^(t) ? w(t Q ) £ £ (39) 

where is a zero *nean, white, Gaussian stationary process, i # e« 


E<x(t)} = £ 

(40) 

E{y(t) y'( t) } = rs tT 

(41) 

r = r* >o 

(42) 


Similarly, for v(t) , from equations (28) and (34), one can see that 
lim E{v(t) } » - Ac CA-I) X B u_ = unknown constant (43) 

1 7* 00 

and 

v(t+l) - v(t) = AC [ (A-I) x (t) + B u ] + AC £(t) (44) 

This leads ua to select the dynamics of v^(t) by the equation 

v(t+l) - v(t) = X(t) ? v(t Q ) ^ 5- (45) 

where ^(t) is a white, Gaussian, stationary noise process with 


statistics 
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E{X(t)}=0. (46) 

E{X(t)X'(T)} * (47) 

— — — tx 

A « A 1 £ 

We remark that if AA is known (or can be estimated on the basis 
of physical considerations) one should select 

£(t) = AA £(t) (48) 

and set 

r = Aa 5 Aa* (49) 

Similarly, if Ac is known (or can be estimated) one should select 

X(t) = AC £(t) (50) 

and set 

A = Ac S AC f (51) 

In view of equations (48) and (50), or physical reasoning, 
one should consider y(t) and X_(t) as two correlated processes, 
i.e. 


E{ X (t) x« (T)} = ^ x s tT 


(52) 


Indeed if both A A and Ac are known or can be estimated, one should set 


ft , = AA E Ac' 

-yx- 


( 53 ) 
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Also £(t) should be correlated with , and X_(t) . Let 


B{£(t)Y'(X)> = Br Y 6 tx 

(54) 

E{£(t) A_'(T) } = Be^t'C 

(55) 


In particular 

£V = H AA' (56) 

—Sr - — 

if AA is known (or can be estimated), and 



(57) 


if Ac is known (or can be estimated). 

The above development allows one, by making certain ap¬ 
proximations , to replace equations (30) and (32) by a linear estimation 
problem with plant dynamica. given by 


rx n (t + i)-i 


w(t+l) 

_ v(t+l) . 


i(t+i) 


"a-agc I -A G “ 


r* (t)i 


r I 0 0 -AG ' 

“n —n—n—n — —rr—n 


— n 


— — — —n—n 

£ 1 £ 


w(t) 

+ 

0 10 £ 

0 0 I - 


- v(t) - 


-001 0 _ 


F £(t) D 



i(t) 

X (t) 

X(t) 

9(t) 

t(t) 


( 58 ) 


and measurement equation given by 
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r (t) 



x (t) 
—n 


w(t) 


+ 0 (t) 


H 


L v(t) 


(59) 


Thus a Kalman-Bucy filter can be designed to generate estimates of 

£ A 

x (t) , w(t), and v(t), denoted respectively by x (t) , w(t), and 
—n — — 

v(t) , based on past measurements of r (T) t <_ T <_ t. 

Recalling that (see equation (19)) 


x(t) 


x (t|t-l) + x (t) 
—n ~n 


(60) 


it is clear that an improved predicted estimate x(tjt-l), and updated 
estimate x(t) of x(_t) can he constructed by 


A 

X 


Ctjt-1) = x Ct [ t—1) + x Ctlt-l 
1 —n —n 1 


xCt) = x (_t|t-l') + x Ct) 
—n 1 


—n 


Cfilal 

Cfilb) 


4.2 Detai ls of Constructing the Compensated Filter 

A 

Using a steady state Kalman-Bucy filter, the estimates x^(t), 
w(t) and v(t) are generated via the following equations 


x (t+1 t) 
—n 1 


[A -A G C ]x Ct) + wCt 1 -AG vCt) -A G QO + HSHL'L 
—n —n—n—n —n — —n—n— —n—rt-- 


-1 


[r Ct) - C x (t t-l)-v(t-l)] (62a) 

— • ti— n 1 — 


x^t-KL) = t) + L [r (t+1) - C x (t+1 t) - v(t)] (62b) 

—x —n —n~n 1 — 


w(t+l) = w(t) + L [r (t+1) 
— — —w —n 


C x (t+1 t) 
—n—n 1 


v(t) ] 


(63) 


v(t+1) = v(t) + L [r (t+1) 
~ — —v —n 


C x (t+1 t) 
—n—n 1 


- v (t) ] 


(64) 
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where L^, L^, are respectively nxr, nxr and rxr constant 
matrices (steady state filter gains), which will be defined below. 
The initial conditions that one might use are 


o 

II 

*■— < 

o 

-p 

.hP 

(65) 

A 

ft* 

o 

tl 

o 

(66) 

A 

\< 

ft 

o 

II 

o 

(67) 


They are chosen because one can view Aa , AB , Ac as random 

matrices with zero means, the nominal values A , B , C used by 

—n —n —Ti 

the designer represent the a. priori mean values of A, B^ and £, 
respectively. 

Now referring back to equations C58) and (59)., define for 
notational convenience the matrices 








0 


Sa 


a;* 


A 

o 


£ 

0 


( 68 ) 




0 

0 



( 69 ) 
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Then M plays the role of the composite plant white noise Ol>(t)) 
intensity matrix, and N_yields the correlation between the composite 
plant white noise }P(t) and the measurement white noise (3(t) . 

Let S denote the steady state predicted error covariance matrix 
associated with the estimation problem defined by equations (58), and 
(59). Then S is a symmetric at least semi-positive definite matrix. 
In addition, it is the positive semi-definite matrix solution to the 
algebraic Riccati equation (take e.g. the dual in [5], 


S - [F - D N 0 _1 H] [S - S H 1 (0 + H S H 1 ) _1 H S] [F - D N 0 -1 H] ' 


+ D[M - N Q -1 ^' ]D' 


(70) 


One can then compute the filter gain matrices L , L and L that appear in 
(62)-(64) by 


L 

-x 

L 

—w 


= S H' (0 + H S H 1 ) 


-1 


(71) 


4.3 Simplification 

The realization of Section 4.2 can be considerably simplified. 
Define the compensated residual process r(t). by 
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r(t) = z(t) - C x(t[t-l) - v(t-l) 

— — ~n— 

From eauation (61) we deduce that 

r(t) = z(t) - C x (tit-1) - C x Ct|t-1L - v(.t-l) 

— — —n—n —n—n — 

Then from equation (15) , this becomes 

A 

r(t) = r (t) - C x (tlt-11 - 

— —n —urn 1 — 

Equations (61), (62), (14) and (74) yield 

A 

x(t+l|t) = X (t+l|t) + X (t+l[t) 

— —n —n 

= A x (tlt-1) + B u + A G r (t) 

—n—n —nr* —n—n—n 

A 

+ (A -A G C )x (t) + w(t) -AG v(t) 

—n - n - n -n ~n — -n~n — 

- A G 9 (9 + H S_ H’ ) -1 r (t) 

» A X(t) + B U + w(t) 

-n— —n— — 

+ [(AG - AGCL - A G L ) - A G 0(0 + HSH' 
—n —n—n-tr-x —n—n~v —n—n-- 

From, equation (71) , it is easy to see that 

CL + L — HS H' (0 + H S H 1 )^ 1 
—n—x —v -—- 

After a little algebra , it can be shown that the last term in 
vanishes for all t. That is, equation (75) reduces to 

x(t+l|t) = A x(t) + B u + w(t) 

— ‘ —n— —n— — 


Thus the compensated state estimate x(t+l) is given by 

A 

x(t+l) = X (t+l|t) + X (t+1) 

— —n 1 —n 

A 

= x (t-KL|t) + x (t+l|t) + L r(t+l) 

—n 1 —n —x~- 

= x(t+l|t) + L r(t+l) 

— —x— 

In addition, equations (63) and (64) become 
w(t+l) = v)(t) + L r(t+l) 

— — “W— 


(72) 


(73) 


(74) 


(75) 


1 ]r(t) 


equation (75) 


(76a) 


(76b) 


(76e) 


( 77 ) 
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v(t+l) = v (t) + L r(t+l) (78) 

— — -v — 

Figure 2 shows the realization of equations (76) to (78) • From 

this representation, one can deduce simpler computational procedures for 

the evaluation of the compensated Kalman filter gain matrices L^, 1^, 

To be specific, we can reduce the computations of the augmented matrices 

F, D, H, M, N (equations (58), (59), (68>, (69)) and the matrix solution 

£in the algebraic Riccati equation (70), and the subsequent evaluation 
of the matrices L^, L^, and by equation (71). After some algebraic 

manipulations with equations (58), (59), (68)-(71) and (17), one obtains 

the following: 


F - D N 0~H = 


A 10 

—n — — 


£ 

0 


L £ 

o i 




D[M-N ©“VjD' = 


H 

%Y 

-€y 

Q- 

-€y 

r 

Q, . 
-yX 

^X 

%x 

A 




( 79 ) 





I 

to 

to 

I 




and equations (70) , (71) become 


S « 


^[S - 


S H' (0 + H S H') 


-1 


H S]F| 



(80) 


L 

-x 

L 
—w 



=*- S H. 1 C0 + H. S H. 1 ) 


( 81 ) 


4.4 Discussion 

The structure of the discrete-time compensated Kalman filter, 
illustrated in Figure 2, has certain appealing physical aspects. The 
major structural difference between the uncompensated Kalman filter 
of Figure 1 and of the compensated one of Figure 2, hinges upon the 
addition of distinct accumulator loops driven, through appropriate 
gains, by the compensated residual vector 3:(t+l) . Note that an 
accumulator is the discrete time analog of an integrator in the continuous 
time case. In the absence of any accumulators, the residual vector of the 
the uncompensated Kalman filter would exhibit bias errors. In the com¬ 
pensated filter these residual bias errors are accumulated (integrated! 

with appropriate weightings (the gain matrices L and L in Figure 2) 

v ~w 

in two different ways. The accumulator that generates the sequence 
w(t) corrects for bias errors in the predict cycle, to compensate for 
the errors modelled by the matrices Aa and AB . This makes sense, because 
w(t) was defined by Eq. (33) in terms of Aa and Ab . The accumulator 
that generates the sequence v(t) corrects for bias errors in the 
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residuals due to modelling errors AC in the measurement equation; 
if AC = 0_, the accumulator channel that generates v(t) would be absent. 

One can then think of w(t) as being a crude estimate of constant 
but unknown disturbances that are additive to the state equations, and 
of v(t) as a crude estimate of constant but unknown bias errors in the 
measurement equation. 

The improved estimate x^Ct+1) generated by the compensated Kalman 

filter (Figure 2) is still instantanously influenced by the compensated 

instantaneous residual r(t+l) through the feedforward gain L . The 

— -x 

nominal dynamics A , B , C are still being utilized and bias corrections 

~~n —n 

via w(t) influence the predicted compensated estimate SHt+ljt) and 
hence the residual. 

Obviously the transient performance of the estimation errors of the 
compensated Kalman filter would hinge upon the numerical values of the 
three gain matrices L , L , and L . These in time would not only de- 

—x —'W “V 

pend upon the nominal parameters, but upon the way the intensity matrices 
of the white noise sequences y(t) - see eq. (39) - and _^(t) - see eq. 

(45) - are selected. It is the authors* opinion that the suggested 
guidelines for the covariance selection are reasonable, since for most 
practical problems the designer has a reasonable idea of the worst 
possible modelling errors, exhibited in Aa , AB , and AC, from the nominal 
parameters. It is important to stress that the white noise intensity 
matrices T and-A not only depend upon the modelling errors, but also 

upon the intensity matrix E of the original plant noise shown by 

eqs. £49) and (51). Furthermore, X^^ and (Jt 1 are correlated according 
to eqs. £52) to C57). . Thus, the guesswork on the part of the designer is 


minimized. 
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5. FURTHER SIMPLIFICATIONS IN PRACTICAL DESIGNS 

At first glance r the compensated Kalman filter might seem some¬ 
what complicated than that of the NMSSKBF alone. We remark that the 
complexity is directly related to the dimensionality of the two 
auxiliary vectors v(t) and w(t) • However, in most cases of practical 
interest, canonical representations can be used to arrive at the 
smallest number of additional accumulators in the realization of the 
compensated Kalman filter. 


5.1 A Single Input Single Output Example 

To illustrate these implications consider the design 
of the compensated Kalman filter in the case of linear, time- 
invariant, stable single input single output plants. Suppose 
that the actual plant is characterized by its transfer function 


G(z) = 


n-1 n-2 

c z + C +...+o^z + c, 

n _ n- 1 _2_1 

n n-1 

z + a z +...+a^z + a- 
n 2 1 


(82) 


Then there are at most 2n unknowns (the a.*s and c. ’s) in the plant 

X 1 

description. 

Let a." and c. i=l,...,n,denote the nominal values of the a. 
m in x 


and c. , respectively. Then the standard controllable representation 

i 


for the actual plant (equation (82)) is 
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x(t+l) 



0 1 


0 

1 



B 


u(t) + £(t) 


( 83 ) 


A 


z(t) 



c ]x(t) + 0(t) 

n — 


( 84 ) 


and the nominal values of A , B , C are (in the same representation) 

-n —n —n 



0 1 0 . 0 

0 0 1 . 0 



B 


—n 


r 


0 

0 

0 

1 


( 85 ) 


( 86 ) 




c 

nn 


] 


C 

—n 


( 87 ) 
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Thus 


Aa = 


£ 

((n-1) rows) 

• •••••• 

5a' 


( 88 ) 


AB = 0 

(89) 

AC = 6c* 

(90) 


where 


6a' = [a-a, a -a , ..., a -a ] 

— ± In 2 2n n nn 

(91) 

5c* = [c«“*c f c—c f • • • f c —c ] 

— 1 In 2 2n n nn 

(92) 


Examine the way the vector wCt).. is defined (.equation (.331)., 

Since AB = 0, w(t) is given by 


w(t) = Aa x(t) 



6a'x(t) 


(93) 


which means that although w(t) is an nxl vector, it really contains 
only one uncertain parameter, namely the scalar w n (t). 


w R (t) = 6a'x(t) 


(94) 
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v(t) in this case is also a scalar 


v(t) = 5c’x(t) 


(95) 


Following then the procedures described in Section 4, one can see 

that the scalars w (t) and v(tl should be modelled as 
- n 


w (t+1) - w (t) = y (t) (96) 

n n n 

v(t+l) - v(t) = X(t) (97) 

with 


E{y n (t)} = 0 

(98) 

E{X(t)} = 0 

(99) 


and 


E{v n (t)Y n (T)} - TJ, tT 

(100) 

E{X(t)A.(x)} = 

(101) 

E{y (t)X(x)} = 0^ x 6 tT 

n 

(102) 

E{C(t)y n (x)} = ^ Y 5 tT 

(103) 

E{£(t)X(X)} = 

(104) 
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Ideal ly , one selects 


T = 6a 1 5 6a 

nn ——- 

A = 6c 1 5 6c 


^ - 5a' 5c 





(105) 

(106) 

(107) 

(108) 
(109) 


In practice, since 6a^ and 6c_ are not known one should use their 
worst possible values in equations (105)-(109) to determine the 
covariances. 

Under these conditions, the equations of the compensated 
Kalman filter become (see equations (76)-(78)) 


x(t+l) « A x(t) + B u + 
— " t i * —n—“ 


L r(t+1) 
—x 


1 

• • • 

0 

w (t) 
n 


( 110 ) 


w (t+1) = w (t) + L r(t+l) 
n n wn 

v(t+l) = v(t) + L v r(t+l) 


(in) 

( 112 ) 
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with 

r(t) = z(t) - C x(.t|t-ll - v(±-l). (113) 

—n— 

where 

a) is a constant nxl gain vector; 

b) L is a constant scalar gain; 

c) is a constant scalar gain* 

5.2 Extension to Multi-Input Multi-Output Systems 

The above procedures can be easily extended to the multi-input 
multi-output systems. We outline the step by step procedure that 
should be followed. 

/ 

Step 1 : Examine the structure of the nxn matrix Aa for arbitrary 
variations of the actual and nominal plant parameters. Letp, 

0<p<n, denote the number of non-zero rows of Aa. Define an nxp 
matrix _P according to the following rule. Let j=l,2, •••? P index 
the columns of P. 

(a) . Let i=l, j=l 

(b) . If the i-th row of Aa is nonzero, set the j-th column of P_ 

equal to e. (the natural basis vector in R n ) , set j=j+l, 
and go to (c) . if the i-th row of Aa is zero, go to (c) . 

(c) . If i=n stop; otherwise set i=i+l and go to (b). 
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Example : Suppose Aa has the structure (where x denotes a nonzero 
element) 


AA - 


0 0 
0 x 
0 0 
x x 


0 0 
0 x 
0 0 
x 0 


Then p=2, and the 4x2 P matrix is given by 


P = 


0 0 
1 0 
0 0 
0 1 


Step 2: Examine the structure of the rxn matrix Ac for arbitrary 
variations of the actual and nominal plant parameters. Let q, 
0<c£r, denote the number of non-zero rows of Ac . Define an rxq 
matrix £ according to the following rule. Let k=l,2,... r q index 
the columns of ^ 

(a) . Let i=l, k=l 

(b) . if the i-th row of AC is non-zero, set the k-th 

column of £ equal to e^ (the natural basic vector in 
R ), set k=k*KL, and go to • If the i-th row of Ac is 
zero, go to ( c )• 
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Cc). If i=r, stop; otherwise, set i=i+l and go to (b) . 


Example: Suppose that Ac has the following structure 



x x 0 0 x 
0 Q Q 0 0 
0 0 0 0 0 


Then cpl and the £ matrix is given by 

“ - 

1 

2= o 

o 

_ — 

Step 3 : Let w.. (t) e K?, X-j(t)£ ^ • such that 


w^t+1) - w x (t) = Y 1 (t) 


with 


ECY-^t)] = £ 

E[Y. (t)x'(x)] = r.fi 
—1 ■‘•1 —1 tx 


(114) 


(115) 

(116) 


Make the identification 
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w(t) = £ w^(t) 

(117) 

Xj^Ct) = £'Y(t) 

(118) 

r = p*F p 

(119) 


Step 4 ; Let v. (t) £ R q , X^Ct) £ R q such that 


with 

v(t+l) - v(t) = X, (t) 

(120) 


E[X 1 (t)] = 0 

(121) 


Et^Ctl^CTU -A^ 

(122) 

Make the 

identification 



v(t) = 2 . ^(t) 

(123) 


X_. (t) = 2'Mt) 

(124) 


a l - 2'A 2 

(125) 

Step 5: 

Assume that S[(t) / Xi ^^ and 

are pairwise correlated. 


E[£(t)Xi<T)l = ^ 5 tx ( 126 ) 

E[£(t)X 1 (T)] = 6 tT (127) 

EtXi(t)X 1 (T)]=2 YXi S t T 


(128) 



Make the identification 



df 

ii 

(129) 


11 

(130) 

~yX 1 

- v V 2 

(131) 


5.3 Reduced Dimension Compensated Kalman Filter: Summary 
of Equations 

The following equations are obtained by substitution of 
equations (114) through (131) into (76) to (78). 


Filter Equations 


x(t+11t) = A x(t) + B u + P w. Ctl 
— 1 —n— —n—-1 

(132a) 

x (t+111+1) = x(t+l| t) + L r Ct+U 

C132&) 

w Ct+1) = w Ct). + L , r (t+1) 

—1 —1 -wl—1 

C133a) 

v (t+1) = v (t) + L r (t+11 
—1 —1 —vl—1 

U33h) 

r. Ct+1). = zCt+1) - C x('t+l 
—1 — — 

t) - a^ct) 

(1341 


Filter Gain Equations 

The filter gain matrices L^Cnxr), L^(pxr)., and L^Cqxrl are given 
by 


* ^ C0 + H. H/ i 


^1 

Ki 


( 135 ) 
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where Y is the unique (symmetric) positive definite solution of the 
(n+p+q)-th order algebraic matrix Riccati equation 



(136) 


F , H , m 2 cure respectively (n+p+q)x(n+p+q), rx(n+p+q) , (n+p+q)x 
(n+p+q) constant matrices given by 


r A P 0 

-n — - 



0 10 


0 0 1 


(137) 




0 . 2 ] 










(138) 


(139) 


5.4 Discussion 

The compensated Kalman filter’equations presented in Section 5.3 
are the recommended ones for practical design. The additional 
workload associated with the computation of the JP and 2 matrices is 
justified in terms of the simplification that results in specific 


problems 
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From a technical viewpoint the essential difference between 
the filters of Section 4,3 and 5.3 is that in the latter case the 
compensated Kalman filter can be shown to possess all the requisite 
controllability and observability conditions which are necessary 
for the existance of a unique positive definite solution to the al¬ 
gebraic matrix Riccati equation and the guaranteed stability of 
the resultant filter* It also pinpoints the additional number 
Cp+q) of accumulators required to stabilize the uncompensated filter. 


The only "guesswork" required by the designer is the selection 
of the intensity matrices F^(pxp) and (qxq) and the correlation 
covariance matrices (nxp) , £2^ (nxq) and £2^ (pxq) • All 


of them scale with the intensity matrix of the plant noise ^(t). 
This is evident from equations (49), (51), (53)-(55), (119)., and 
(125)-(128), from which we obtain 


4- 

p'Aa E Aa'p 

(140) 

II 

rH 

<1 

q 1 Ac E_ Ac'q 

(141) 


= E Aa'p 

(142) 


= E_ Ac'q 

(143) 

& , 

= p'Aa S AC'Q 

(144) 
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Sinee E is assumed known, and P and £ are readily evaluated, the 

selection of T , A , SL. , ft-. 9 and ft . only involves the use 

j- —I %y n 


of judicious estimates for AA and AC^ by the designer. As 
remarked before, these estimates can be usually found from a worst 
case analysis, i,e,, the worst probable deviation of each parameter 
from its assumed nominal value. Of course, there is still an ele¬ 
ment of judicious judgement to be made; at least in this design the 
"guesswork" can be related to the degree of worst deviation of the 
nominal plant from the actual one. 



-38- 


6. CONCLUSIONS 

A method for compensating the mismatched constant gain discrete time 
Kalman filter has been presented. The resultant compensated Kalman filter 
is time invariant, and the gains are all computed off-line, with some 
added complexity to the estimator. The compensation consists of the intro¬ 
duction of feed-forward accumulating (integrating) channels between the 
residual process and the uncompensated mismatched filter. 

The compensated Kalman filter has the property that bias errors in 
the state estimates are eliminated asymptotically. More complex algorithms 
have to be used if unbiased estimates are required for all t. 



I 
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